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(57) Abstract: There is provided an azimuth measure- 
ment device capable of not obtaining erroneous offset in- 
formation when a change is made while maintaining a 
posture in a particular direction and capable of obtaining 
corresponding offset information when a change is made 
in an arbitrary direction. Data from a 3-axis sensor de- 
tecting earth magnetism is processed by a data processing 
unit (19). The processing unit (19) repeatedly, by a pre- 
determined number of times or more, acquires 3-axis out- 
put data when the earth magnetism direction has changed 
in a 3 -dimensional space. On the 3 -dimensional coordi- 
nates having the 3-axis output data as the respective axis 
components, a coordinate of a position where the irregu- 
larities of the distance from the 3-axis output data group 
is minimum is statistically estimated so as to be used a 
reference point. According to the coordinate of the ref- 
erence point, the 3-axis output data offset information is 
calculated to judge whether the 3-axis output data group 
is distributed in the vicinity of a particular plane. When 
the 3-axis output data group is judged to be distributed 
in the vicinity of a particular plane, the estimation of the 
coordinate of the reference point is not performed or the 
estimated coordinate of the reference point is discarded. 
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x^n%mm^&^bK£y)*mmmamM*) „ 

[0004] 03«, ^MMiJ^^^v^-c^ir^h'ff #^^#-rs^feo«^^PJ-r 

■7 s — ^Sz^rFf^X— ^^tl&N^^^jgLSl^-rSo &*3, Sx, Sy, SzmX& 
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[0006] Sx, sy, Szfcyk^-em-i-^bfr-e^&o 

Sx = a-Mx + Cx (1) 
Sy = a-My + Cy (2) 
Sz = a-Mz + Cz (3) 
fc/cU a(ixi*-;^^HEx, y$fi*— /^H^-HEyfe £t^z#^— /^i^HEz© 

^) o 

[0007] — Mx, My, MzbM<DM&felfc<DMy'Vfo2>o 
[0008] [^1] 

M = /.Y/£ +M| (4) 

[0009] [#C2] 

r = a 1 jM 2 x +M l y +M^ (5) 

(Sx-Cx) 2 + (Sx-Cx) 2 + (Sx-Cx) 2 = r 2 (6) 
i"jfefc>*>^ (Sx, Sy, Sz)tt&1*£3p^OP(Cx, Cy, Cz) fl>£>— ^Ogggfr^gV ^ 

[0010] foT,Pl(Slx, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z) , ••• 

*s-C#, ^OMfffi^ib^-fes/hCx, Cy*5«tO!CzSr#5ri:dS-e#5 e 
[0011] ^MOPOti^^^S^Of+^^i^^^^ H^^5l#^tb5Sx, Sy, Szf3 
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[0012] [fc3] 



z^xk-^) T Si M~ s *) T s >M-sX 

Z Si * ( Si y ~ S y) Z Si y ( Si y ~ S y ) Z Si z ( Si y ~ S y ) 
Z Si * ~ 5 z ) Z S > ~ S z ) Z ffl z fc'z - S z ) 

Zfe+57; + ^X^-C)" 
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[0014] [#[5] 
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6\, = — Z^'v 
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[0015] [M 
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'• 2 = Z K - c * ) 2 + (®, - c, > + (a, - c z ) 2 } 
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[0018] — ^ ^-^^yyrm^w^nx^^mmnum'f—^s^, s y , sz^^^cd 

^ttiU ^@*<£>9**-^Pl (Six, Sly, Slz), P2(S2x, S2y, S2z) , P3(S3x, S3 

y, S3z), ■■■^(Dmm^nb^^M^^^o^&muop^mmc^, c y , c 
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[0023] ^mm^m^mmmm^mm^ mitDMm&mz.&^x, mm^m^m^m 
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[0040] ^Cir^Igffr®^ 1 2tt, xW^ir^^HEx, yttigt^ir^HEy^ it^z 
W^ir^HEz(7)l&^^^^ramjE^m^-f-6j:5^^oTV>6 0 

[0041] x#^^ir^HEx N y#^^i?^HEy*3j;^z^« 

ir^HEz^^m^5fc*(D^cDT\a^ir^««M^12(Dffi^mj±^x$fi 
^ir^HEx, y^^ir^HEy^it^zfi^-fe^f-HEz^^f'J-e^I^PL 
, xiit^^fHEx, yft^^^^HEyio.tt^ztt^^-fe^HEz^^ffl^J^tL 

[0042] msmiEm m^^ieti. m^mmm^Em m&mmi-Zo mmmmmm 
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3z), ■-■fim7£<D¥ffip<D&mzfrm\^x^zfr¥yfaWffi'tz 0 mmjfmtvxn 
, ±^:(7)©cx, c y , czimir^m^-^m^^^Mm^^nm 
[0051] ms] 



A = 



'2Xfe -s x ) ^ Sjy (si x -s x ) Z Si M-s x ) ' 
X a, (a, - ) £ a, (», - s, ) £ a, (a, - s, ) 
y a, (a, - s z ) j; si, (si z - s z ) x »« - s z ) 
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) <D^n^:(Dm<D^m% I det(A) | Srff-^LT, ^fcjfittfttfPl (Six, Sly, SI 
z), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z), •••{^#^© 5 P®P(D^#^^^? 

[0052] 3: (12) <Dff?«tf>ffite:, WcD^Lfe0#^^r6*^-^m^^ff^^^ 

V^i^t?fctt^Pl(Slx, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3 

[oo53] ^fc, iFit-J;oT^t$^fiit5o #iantfe©rt^, Jis-e 

det(A)/r 6 £ff|fLT, ^j£l\lb3VM3A^fc;MPl (Six, SI 
y, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z) , ■••{i#^<D^pffiPcDi£{# 

[0054] ^/c, PI (Six, Sly, Slz), P2(S2x, S2y, S2z) , P3(S3x, S3y, S3z), — 

#^¥®P<^3fi#(^*bTV^^^5^^J®fi-SSiJO^fetLT, PI (Six, SI 
y, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z), •••tf^P ffiP^lt^U PI 
(Six, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z) , ••■frhifefe&frl 

^ffip^TOEgit^ffifu 

aS +bS +cS +d = 0 (13) 



[0055] ^fc,Pl(Slx, Sly, Slz), P2(S2x, S2y, S2z) , P3(S3x, S3y, S3z), 
[0056] IWC9] 



fc#?U a 2 + b 2 + c 2 =l 
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(15) 



aS +bS +cS +d = 0 
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[0057] mw 



XX = Sr x (Sr x -sCj 
ZZ = Si z (Si z -Si z ) 



XY = Si x (st y - Si y ) = Si y (Si x - Si x ) 
YZ = Si y (s\ -Si;)= Si z (Si y - Sf y ) 
ZX = Sr z [Si £ -Sf x )= Si x (Sr z - Si~) 



[oo58] imw 

DetO = YY xZZ - YZ x YZ 
Detl = ZZ x XX - ZX x ZX 
Detl = XX x IT - AT x AT 

= l^L/cB^<Z\ ^mP^^-T^-VhV, DetO, Detl, r>et2itttl^tl<D&$k 
[0059] netO&M*<DW&(Z.<Dt%aL=l) 



[0060] [#C12] 



77 


YZ' 


~b 




"AT" 


YZ 


ZZ_ 


c 




ZX 
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XY 
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XY~ 
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ZX~ 


XY 


YY 
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YZ _ 



[0063] [$fcl5] 



PI (Six, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z) , 
aSL + bSi„ + cSu + d 



di = 



(16) 



Va 2 +6 2 + c 2 

<Z)^j6»/jNjg^*^(0i6) N r©i^pjfOTTtfe5/5^^(aot, pi (s 

lx, Sly, Slz), P2(S2x, S2y, S2z) , P3(S3x, S3y, S3z), 

[0064] WV^^Si, m^$tlfc¥®Pl-J;oT2o^fiJ$n/c— 

m^tlfci¥®Pd^*^iinfc:^^¥®Pi©IEil©^ffi^.m^^f-^ 

^§>^^tifc^ffi^^^fit^^^^ffip^©mit(D^^B^©^}0^^fi 

[0065] ^LT, PI (Six, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z), ••• 

j^^st^u ^-fe^/h'it n<Dmm>ff ^v^5^i-s e pi (six, si y 

, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z) , —&lfcfe<D¥-ffiP(Dj&&\Z. 

ftmisX\^bmwr&ti?&^m&fe, _l^(7) (Dm&nwvxmmMop&mfeu 
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[0066] rtnao-c, ^-^mmm^^i^Mtmmn^^^m^mt^'r, m 

[0067] £38, PI (Six, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3z), — 2* 
SP(vi*^Sr^LTtJ;V\ r*U£<fco*t\ ^{^lt?«gl^ffl#«> Sx, Sy, 

[0068] 08«, ^0^(DBlHW^^S3V>T^ofc^-7ir^Mf #(DSi#?r03ffi-r5^ 

08111*31 vr, 7*— ^y77SP18fi, iMMIJ^T^^Sx, Sy, Sz£&#L^$/ 
^rt-AtbS 0 &*3 X /^XcOi^A^t-i^^tbfcjrMMJ^— ^Sx, Sy, Sz^S 
^M^^^^tLS^fi, &#Lfc*M^J5£7*— *Sx, Sy, Sz&s*y?TfcA 
W3:<Xb&\ CxtV^SII) 

fen*?— $m%wmzm^x\^frmm~ir%>o (^^ o si2) 

— *&#8fcNtej£LTV vftl ^^fi, ^tV^SI 1 fcMSo 
[0069] — ^ t*— ?s<y7rMl8\Z&W£frX^ZfflM%Ml£ i 7*-- ^Sx, Sy, Sz/5S^ff^ 

Ma«J^7^Sx, Sy, SzSr0f3£W"7* fc -^St#^cN^tiK^mu I^l±lt 
tzM*^*- *P1 (Six, Sly, Slz), P2(S2x, S2y, S2z), P3(S3x, S3y, S3 

z), ■■■fimfc(D^mp<Dfcmzft^x\s^fa¥ofa¥i\m-t : 5 0 f-^^ 

T^lS^^W^HlJ^— ^Sx, Sy, Sz&jff5£©7*— *&#^£ttlfc^tiJUfc 
^^J^CTt"— ^^T^lS^^^tLTV^^^IJ^T 2 — ^Sx, Sy 

V\ (^7^°S13) 
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